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(57) Abstract 

Two reflecting devices are fixed out of the moving field (A, B) of a moving 
body in order to determine the coordinates of its movement (x^, y^, p^), said ref- 
lecting devices being made of a reflecting sheet secured on a pole. On the moving 
body are fitted according to a given horizontal interval (a) a first goniometrical in- 
stallation provided with a telemetry device and a second goniometrical installa- 
tion, both comprising a power mechanism which drives a transmitter-receiver on a 
vertical axis. Upon receiving a maximum intensity wave reflected by one of the 
reflecting installations, the instantaneous position is determined and, hence, a ref- 
lecting pole is identified and the angle to be measured is determined, then a corresponding signal is transmitted to a calcu- 
lator which gives the location coordinates as a result of the measuring of two angles, of a distance and of a geometrical tri- 
angulation. The calculation is made possible by means of the measuring of two distances from the reflecting installations 
or of the measuring of one distance and two angles. 

(57) Zusammenfassung 

Fur die Ermittlung der Bewegungskoordinaten (x^, y^, p^) eines ortsbeweglichen Korpers werden zwei ausserhalb 
seines Bewegungsbereiches fest angebrachte Reflektoreinrichtungen (A, B) verwendet, die aus einem Pfosten mit einer dar- 
umgeiegten Reflexfolie bestehen. Auf dem ortsbeweglichen Korper sind in bestimmtem horizontalen Abstand (a) vonein- 
ander eine Winkelmesseinrichtung mit einer Distanzmesseinrichtung sowie eine zweite Winkelmesseinrichtung vorgese- 
hen, die je Winkelmessung einen Drehantrieb aufweisen, der je eine Sender- und Empfangereinheit um eine yertikale 
Achse dreht, Beim Empfang einer von den Reflektoreinrichtungen zuruckgeworfenen Strahlung maximaler Intensitat wird 
die momentane Drehposition und damit ein zu vermessender Reflektorpfosten erkannt und der zu messende Winkel be- 
stimmt und ein entsprechendes Signal an einen Rechner weitergegeben, der die Postionskoordinaten aufgrund der Mes- 
sung von zwei Winkeln, einer Distanz und den geometrischen Dreieckbeziehungen errechnet. Die Berechnung ist auch 
aufgrund der Messung von zwei Distanzen zu den Reflektoreinrichtungen oder der Messung von einer Distanz und von 
zwei Winkeln moglich. 
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Verfahren und Anlage zur Ermittlung der Bewegungskoordinaten 
fiir den richtungsgesteuerten Arbeitsablauf emes orts- 
beweglichen Korpers . 



'In zahlreichan technischen Bersichen ist as erf orderllch, 
rait hoher Genauigkeit die Richtung eines ortsbeu/eglichen 
Korpers in bezug auf die Umgebung zu stauern, insbesondere , 
u/enn der Arbeitsablauf einer Maschine aufgrund aines Pro- 
grammes duroh die Bahn der Drtsbeinegung der Maschine be- 
stimmt ist. Dies trifft beispielsu/aise fur mobile Roboter 
zu, uiie in der Schuieizer Patentschrif t (Gesuch Nr. 1097/76) 
beschrieben ist, Eine vergleichbare Auf gabenstellung ist z.B. 
auch bei der Steuerung von Strassenbaumaschinen , Erzabbau- 
maschinen im Tagebau, Vortriabsraaschinen im Untertagebau, 
Oberflachenf orraraaachinen, usu»« vorhanden. 

Mechanische Uerfahren zur Richtungssteuerung, wie z.B. durch 
Verlegen von Schienen sind haufig nicht anmendbar. Es uiurde 
bareits auch vorgeschlagen, die Richtungssteuerung von Ma- 
schinan mit Hilfe von Laserstrahlen auszufUhren, Jedoch oft 
ist sine solche Steuerung uneruGnscht und in ihrer Anpas- 
sungsfahigkeit und Genauigkeit nicht ausreichend. Die genaue 
Anordnung und Ausrichtung der Anlagenteile einer Lasersteue- 
rung ist mit hohem Aufujand verbunden, der Wartungsauf wand 
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ist vsrhaltnismassig gross und es bestehen haufig auch Be- 
furchtungen hinsichtlich einer moglichen Schadlichkeit der 
Strahlung fiir das Personal. 

Der vorliegendan Erfindung liegt die Aufgabe zugrunde, sin 
Verfahren zur Ermittlung beliebiger Bswegungskoordinaten 
fur den richtungsgesteuerten Arbeitsablauf eines ortsbeweg- 
lichen Korpers zu finden, das sine hohe Genauigkeit, ureit- 
gehende Unampf indlichkeit gegenuber Storeinf lussan aufiueist 
und fortlaufend uiahrend der Ortsbewegung durchfuhrbar ist* 
Ausserdem soil das Verfahren mit geringem Aufmand von Ge- 
schicklichkaits- und Handarbeit ausfuhrbar sain. Insbeson- 
dere soil ein Verfahren gefunden o/erden, das sich besonders 
in Verbindung mit der programmierten S'teuerung von mobilen 
Robotern signet, indem es die hierfur erf orderlichan Posi- 
tions- bzujo Ortsbeu/egungskoordinaten als Eingaba liefert. 
Oiese Aufgaben luerden gelost durch ein Verfahren gemass den 
Definitionen der Patentanspruche. 

Die elektronische Distanzmessung kann rait an sich bekanntan 
elektronischen Distanzmessern mit Lauf zeitmessung von ko- 
dierten elsktromagnetischen Wellen z.Bo in vorteilhaf ter 
Ausfiihrungsf orm durch Intensitatsmodulation erfolgen. Als 
Mass fur die zu messende Distanz dient dabei die Laufzeit 
zwischen der aus einem Sender austretenden und von einem 
Reflektor in einan Empfanger zuruckgeu^orf enen Welle. Ein ge- 
eigneter moderner elektronischer Distanzmssser , der mit Licht- 
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uiellen arbeitet, ist beispislsiueiss unter der Bezeichnung 



ten disser Firma beschrieben. 

In vortBilhafter Ausfuhrungsf orra des Uerfahrens u/erdan als 
Reflektoreinrichtung omnidirektionala Tripelspiegel varmen- 
det, die' die Eigenschaft haben, unter beliebigen Winkaln die 
einfallenden Strahlsn urn 180° umzulenksn, so dass sis in der 
Einfallrichtung zuriickrePlektiert u/erden. Daraus ergibt sich 
der bedautende Uorteil, dass verhaltnismassig klaine Raflek- 
torpfosten mit beispielsiusise einsm Durchmesser von 5-10 
cm bei einam Abstand void Distanzmessar von ca. 50 m varmen- 
det warden konnsn, und dank des grossen Arbeitsufinkals von 
360° dersalben kaina besondere Ausrichtung. bzuj. Montageein- 
richtungen erforderlich sind. 

Es ist fur die Bestitnmung der Bewegungskoordinaten mit Hilfe 
der elektronischan Oistanzmessung erforderlich, dass eine 
von den Distanzmessern ausgasandts Strahlung auf eine zum 
voraus getoahlte Reflektoreinrichtung auftrifft, deshalb u/ird 
in vorteilhaf ter Ausfuhrungsf orm des Verfahrens die Ausrich- 
tung des Distanzmessers auf den Ref lektorpf osten mittels Ziel- 
suche ausgefuhrt, durch die das Gerat um eine Uertikalachse 
des ortsbaiaeglichen KcSrpers geschu/enkt luird, bis die hochsta 
Intensitat des ref lektierten Strahls von dem runden Reflek- 
torpfosten des Distanzmessgerates empfangen wird. Da die 
Schuenkbewegung des somit auch als Suchstrahl veruandetan 



DM 500 der Firma Kern AG, CH-Aarau, bekannt und in Prospek 
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Messtrahles um sine vertikale Achse erfolgt, uiird in ureiterer 
vorteilhaf ter Ausfuhrungsf orm des Uerfahrens das Nachfuhren 
des Distanzmessgerates mit Hilfa des Dif f erenzsignals als 
Fuhrungsgrosse von zuiei unmittelbar benachbarten, luaagrecht 
angeordneten Empf angerdioden (oder Empf angsf lachen einar ge- 
meinsamen Diode, ZoB^ SFH 204 der Fa. Siemens) des Empfangs-* 
gerates erzielt, 

Uortailhaft kann die Anlage bzu/. ihr Gerat zur slektroni- 
schen Ausurertung zusatzlich rait eineni Kurskreisal verbunden 
sein, um bei Ausfuhrung der slektronischen Oistanzmessung 
bei Stillstand des ortsbeu/Bglichen KSrpers uiahrend der Wei- 
terbawegung sine luesen'bliche Kursabu/eichung zu vBrh±ndern« 
Ein Kurskreisal ist jedoch nicht arforderlich bei einer Aus- 
fuhrungsf orm der Erf indung bei der fortlaufend die Messung 
mindestens eines Winkels erfolgt, der zu/ischen einer Bezugs- 
achse des ortsbeweglichen Korpsrs und einer Verbindungslinie 
vorhanden ist, die ziaischen einer am ortsbeureglichen Korper 
angebrachten Einrichtung zur Winkelmessung und einer Raflak- 
toreinrichtung verlauft. 

Eine fur die beruhrungslose Winkelmessung geeignete erfin- 
dungsgemasse Einrichtung hat sine Sender- und Empf angerein-, 
richtung fur eine gebundelte Strahlung, dersn Durchmessar auf 
eine Distanz von 50 m z.B« 60 mm betragt, einen mit dem Sen- 
der und Empfanger verbundsnen Winkelkodierer zur Abgabe eines 
dem gemessenen Winkal entsprechenden Signales, laenn die von 
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dem Etnpfanger aufganommena Strahlungsintensitat ein Maximum 
erreicht hat, und einen mit Servomotor angetriebenan Dreh- 
tisch resp. Vorrichtung zur Aufnahma, Ausrichtung bzu». Nach- 
fuhrung das Senders und das fest mit ihm gekoppelten Empfan- 
gers auf dia Winkelposition, bei der die maximale Strahlungs- 
intensitat empfangen u/urde. 

Als Reflektoreinrichtung uierden Pfosten variuendat, urn dia 
Bine Reflexfolie entsprachend dem Tripelspiegelprinzip ge- 
lagt ist. Derartige Raflexfolien sind z.B. unter der Handals- 
bezeichnung der Firma 3M, St, Paul, Minnesota/USA , "Scotch 
light Reflexfoil High intensity grade 2870" bekannt. Die 
Funktion: Ref laxintensitat in Abhangigkeit des Einfallu/in- 
kels. verlauft nach einer "Glockenkurve" , deren Spitze die 
maximale Ihtensitat der ref lektieften Strahlung" ergibt, u/enn 
die Winkelmessung hzvs. deren Sender- und Empf angareinhait 
auf die fur die Koordinatsnbestimmung massgabliche Mittel- 
achse des Ref lektorpf ostens ausgerichtet ist. Der Durchmasser 
der Pfosten der Raf lektoreinrichtungen betragt beispials- 
iveise 100 mm. 

Mittels z\uei unmittelbar benachbarten, uraagrecht angaordne- 
ten Empfangerdioden kann die Intensitat der Ruckstrahlung 
fur die Fuhrungsgrdssa der Zielsuche als Summs gebildet ujer- 
den. Wenn sich der Lichtfleck von der Symmatrielinie der 
beiden Diodan verschiebt, andern sich die Teilsummen der 
Dioden. Aufgrund dieser Veranderung u»ird ein Dif f erenzsignal 
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zur Fuhrungsgrosse der Nachfuhrung gebildet. Mittels dieser 
Einrichtung bleibt der tfinkalmesstrahl trotz der Weiterbe- 
uregung auf die Mittelachse der zum voraus bestimmten Re- 
f lektoreinrichtungen ausgerichtet , so dass die Bewegungs- 
koordinaten uiahrend der Beu/egung des Korpers fortlaufend be- 
stimmt merden konnen, vorausgesetzt, dass sine zu/eite ver- 
gleichbare Einrichtung Fur die Oistanz- oder Winkelmessung 
auf .die zu/eite Ref lektoreinrichtung ausgerichtet ist und ent- 
sprechend der Beu/egung nachgefuhrt uiird. 

Im folgenden wird die ErFindung anhand der Zeichnungen er- 
lautertoEs zeigt: 

Fig« 1 sine schematische Darstellung einer Anlage 

zur DurchFuhrung des UerFahrens, 

Fig* 2 sine graphische Darstellung der Position der 

Ref lektoreinrichtung sou/ie der momentanen 
Position des ortsbetueglichen Korpers in be- 
zug auf Bin Koordinatensystem, 

Fig. 3+4 sine graphische Darstellung der geometrischsn 
Gegebenheiten Fur die Koordinatenbestimraung 
aufgrund der Messung von einer Distanz und 
von ziaei Winkeln und eine Darstellung der 
Rechnerarbeit , 
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Fig, 5+6 sine Darstellung entsprechend Fig* 3 und 4, 
jedoch fur eine Koordinatenbestimraung auf- 
grund der Messung von drei Winkein, 

Fig, 7 eine schematische Darstellung einer Anordnung 

fur die Winkel- und/oder Distanzmessung und 

Fig, 8 die Funktion der Fuhrungsgrossen fur die 

Zielsuche und der Nachfuhrung, 



Das Distanzmessgerat 2 ist uber einen Schiuenkantrieb 4 fest 
auf dam ortsbeu/eglichen Korper 6 bef estigt • und zur Ausfuh- 
rung einer Suchbeu/egung um die vertikale Welle 8' des Schu/enk- 
antriebes schu/enkbar. Der ortsbevuegliche Korper entspricht • 
beispielsureise einem Fahrzeug, das mit einer Programmsteue- 
rung fur seine Beu/egung uersehen ist, die sich an den er- 
mittelten Koordinateniuert bzu/, der Winkelposition in bezug 
auf Bin festgelegtes Koordinatensystem orientiert. 

Fur die automatische Richtungssteuerung des Fahrzeuges ist 
an einer Stelle B soiaie an einer Stelle C des Fahrbereiches 
eine Vielzahl von Tripelspiegeln ID an einem nicht darge- 
stellten Pfostan in Form sines Folienelementes angebracht, 
von denan einer in Fig* 1 dargestsllt ist, 

Ein an dem Distanzmessgera t befestigtsr Sander 12 gibt mit- 
tels einer Halbleiterdiode durch die nicht dargestellte Dptik 
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einen Inf raratstrahl 14 ab, dessen Welle intensitatsmoduliert 
ist. Sobald der Tripelspisgel 10 durch die Suchbewegung des 
Distanzmessgeratss 2 in den Bereich des Strahles 14 gelangt 
und folglich ein Tail des Strahles vom Tripelspisgel reflek- 
tiert den Empfanger errsicht, urird die Suchbeuregung des Ce- 
rates 2 gestoppt, um in dieser Position auf an sich bekannta " 
Weise eine Vielzahl von Distanzmessungen vorzunehmen, deren 
Mittelu/ert durch eine elektronische Rechnung ermittelt urird. 
Eine entsprechende Messung u/ird auch an dem zti/eiten Tripel- 
spiegel ZoBo entsprechend den Positionen C nach Fig. 2 vor- 
genommen, so dass eine elektronische Rechnung aufgrund der 
ermittelten Strecken AB und AC entsprechend der Darstellung 
in Fig. 2 die Strecken AD und ¥d bzu/. die Koordinatenwerte 
Oder den Richtungswinkel ^ der Fahrzeugposition bzir. Fahr- 
zeugrichtung ermitteln kann. 

Oer reflektisrte Strahl 16 gelangt dabei in dem Oistanzmess- 
gerat 2 uber die Reflektion an einem halbdurchlasslgen Spie- 
gel 18 und einem vollref lektierenden Spiegel 20 durch eine 
Sammellinse 22 zu dem -Empf angerteil 24 des Cerates, Der Em- 
pfangerteil 24 gibt an eine Entstoreinrichtung 26 fur den 
Schtuenkantrieb 4 ein Signal ureiter, durch das die Suchbeme- 
gung gestoppt u;ird. Ausserdem u/ird der Empf angerteil 24 mit 
einer Einrichtung 28 fur die elektronische Ausu/ertung verbun- 
den, um aufgrund der Phasendif f erenz ziuischen der Welle der 
abgesandten Strahlung soufie der Welle der von dem Tripelspie- 
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gel 10 zuruckgemorfenen Strahlung die Entfernung zu berachnen. 
Das Ergebnis u/ird an ein digitalas AnzBigegsrat 30 souiie an 
einen Rechner 32 uisitargeleitet. In dem Rechner 32 erfolgt 
die ertuahnte Berechnung der Fahrzeugposition aufgrund der in 
Fig. 2 dargestellten georaetrischen Beziehung. 
Durch die Anordnung der. R.ef lektorpf osten an den Stellen B 
und C, die in bezug auf das eine Koordinatenachse bestimmen- 
de Gxtternord festgelegt ist sou»ie die erfolgte elektronische 
Messung der Distanzen das Distanzmessgeratas bzw. aines Be- 
zugspunktes A des Fahrzauges 6, sind die in Fig. 2 darge- 
stellten Streckan BC, AB und AC sou;ie der Winkel zu/ischen 
der Strecke BC und der Strecke BD bzw. einer Koordinaten- 
achse bekannt. Der Winkel «^ ergibt sich durch die folgende 
Beziehung 



ot = 2 



arcos 



\ Q ( Q -^AC ) 
\ AB . BC 



Oabei ist Q 



(AB -.. AC -I- BC) 
2 



Der Winkel ^ berechnet sich dann u/ie folgt: 



P = arcos ^- cos ( c( + <r + 90°)J 



OMPI 
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Die Strecken AD und BD rechnen sich dann uria folgt: 

AD = AB * cosp> 
BD = AB • sin 

Die Strscke AD 'entspricht dabei beispielswaise dem Drdinaten- 
u/ert'eines Kartesischen Koordinatensystems und BD dem Abszis- 
senu;8rt« 

Da hiermit der Winkal P> errachnet ist und der Winkel ^ durch 
die am Gerat elaktronisch abnahmbare Halteposition der Such- 
beuiegung bastimmt ist, lasst sich dann der Winkel der 
Fahrtrichtung des. Fahrzeuges 6 mie folgt bestimmen: 

X = 180 - ( ^ + p> + 90°) 

Bai der Programmsteuerung der Bau/egung des Fahrzeuges 6, mie 
as beispielsu/eise in der Schiueizer Patentschrif t Nr. 1097/76 
baschrieben ist, kann das Programm mit darn erniittalten Koor- 
dinatenuiert vrerglichen u/erden, urn bei Abmeichung eine Kurs- 
korrektur auszufuhren. Beim Waschen einas Flugzeuges oder 
aines andaran grossan Korpars mit Hilfe aines Waschf ahrzeuges , 
nimmt das Waschf ahrzaug schritturaise varschiedane Positionen 
ein, von denen aus mit Hilfe der Hechanik des Waschf ahrzeu- 
ges die Bursten uber die Ofaerflache des Flugzeuges beiuagt 
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uierden. Die Bestimmung der Koordinateri der jau/eiligen Fahr- 
zeugposition kann dann mit hoher Genauigksit mahrend dos 
Stillstands das Fahrzeuges ausgefuhrt msrden. Abhangig von 
dar Geschu/indigkeit der elsktronischen Distanzmessung und 
der Verarbeitung der gamessanen Warte in dam Rechner der An- 
laga soiuia von der Arbeitsgeschujindigkait das Fahrzaugas ist. 
es auch moglich, die Erinittlung der Bau/egungskoordinaten 
uiahr.and der Bemegung das Fahrzeuges auszufuhran. Dias ist 
2,B, bai einer Distanzmessf requenz von 5 Hz und einer Winkal- 
messfraquenz von 10 Hz bei einer FahrgeschiBindigkeit von 
20 cm/s moglich. Falls jedoch die Messung dar Distanzen AB, 
AC bzu(. die Ermittlung der Beiaegungskoordinaten mahrend des 
vorubergahenden Stillstandas des Fahrzeuges ausgefuhrt uiird, 
und zwischen dan einzelnen Stillstandspositionen varhaltnis- 
massig grossere Waglangen zuruckzulegen sind, so erapfiahlt 
es sich, zusatzlich einen Kurskreisel 34 zu veriuenden, der 
wahrend dar Bewegung das Fahrzeuges eventuelle Kursabu/eichun- 
gen der Rechenelektronik der Anlage raittailt. Kurskreisel sind 
fur die Richtungshaltung bekannt und sind mit einem Mess- 
tuertgeber versehen, der Aenderungan des Winkels zu/ischen dar 
Laufachsa des Kurskreisels und seines ausseren Rahraens, der 
mit dem Fahrzeug 6 fast verbunden ist, angibt. 

Bei Ueruiendung von zu/ei auf dem ortsbeu/eglichen KSrper in 
Abstand voneinander angebrachten Messainrichtungen (Fig. 7) 
fur die Distanz- und/odar Winkelmessung an.den Stellan M und 
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L entsprechend der Darstellung nach Fig. 3 oder an deh Stel- 
len C und E entsprechend der Darstellung der Fig, 5 ist sin 
Kurskreisel tiberflussig, da in diasem Fall die Messeinrich- 
tungen auf die Ref lektoreinrichtungen V und T nach Fig, 3 
bxw. A und B nach Fig, 5 uiahrend der Beu/egung durch Nach- 
fuhrung ausgerichtet bleiben, luahrend im Beispiel nach Fig# • 
2 sine Messeinrichtung zuiischen den Ref lektoreinrichtungen 
B, C hin- und herschurenken muss, falls nicht an gleicher 
Stelle bzuf, auf gleicher Achse Distanzinesseinrichtungen mit 
voneinander unabhangiger automatischer Nachfuhrung auf je 
eine Ref lektoreinrichtung varmendet uierden. 

Die Berechnung des Richtungsu/inkals der Fahrzeugachsa ist 
den Darstellungen des Rechnungstueges in dan Figuren 4 und 6 
fur zwei Ausf uhrungsbeispiele des erf iridungsgemassen Ver- 
fahrens zu entnehmen* 

Fig« 7 zeigt eine Messeinrichtung, von der an den Steilen M 
und L nach Fig* 3 und den Steilen C und E nach Fig. 5 auf 
dem Fahrzeug im Abstand a ihrer Drehachsen voneinandar je 
eine angeordnet ist. Der Drehantrieb 40 ist ein Schneckenge- 
triebe mit einem Untersetzungsvarhaltnis von 1 : ISO, u/ird 
mit einer max. Geschu/indigkeit von z.B. 5 UpM angetriaben. An 
der Achse der Getriebe mird ein Absolutuiinkelgeber 50 z.B. 
mit 10 bit Auflosung und am Antrieb der Getriebe ein Absolut- 
winkelgeber 52 von 6 bit Auflosung angekoppelt und elektrisch 
via eine nicht dargestsllta, sogenannte "V"-Logik synchroni- 
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siert. Die auf diese Art erreichbare Winkelauf losung betragt 
bei einer Distanz von ca. 50 m etu/a 0,01 Grad. 
Fig. 8 28igt die typischa Funktion der Fuhrungsgrossan fur 
die Zielsuche (Glockenkurve) und der Dif f erenzmessung. 
Die erforderlichen elektronischen Bausteine und ihre geeig- 
nete Kombination fur die Veru/irklichung der angsgebenen Ar- 
beitsu/eise dar Messeinrichtung sind durch den Fachmann be- 
kannt und nicht Gegenstand der vorliegenden Erfindung. 
Das erfindungsgemasse Verfahren ermoglicht eina automatische 
Richtungsstauerung eines ortsbeiueglichen Korpers rait einer 
hohen Genauigkeit, da die elektronische Distanzmessung der 
Distanzen M, TTTT mit siner Genauigkeit yon i 1,0 era erfolgt 
und auch die Winkelmsssung sine hohe Genauigkeit zulasst. 
Insbesondere bririgt die Veriaendung uon Tripelspiegeln bzw. 
entsprechander Ref lexf olien, deren Anbringung an vorgegebe- 
nen Stellen keine besondere Sorgfalt arfordert, grosse Uor- 
teile mit sich, da dar omnidirektionale Ref lektorpf osten 
einen Arbeitsbereich uon ca. 360° hat, d.h. die Richtungsum- 
kehr des einfallenden Strahles unabhangig von der Winkellage 
des Reflektorpf ostens zum Boden luie zum Strahlungserzeuger 
ist. 

Es versteht sich, dass das erfindungsgemasse Verfahren in 
zahlreichen Bereichen sine vorteilhafte Anmendung finden 
kann, z.B. auch fur fahrbare Roboter wis fiir die Autoraati- 
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sierung von Containerbahnhof en, Bau- und FSrderanlagen, 
landwirtschaf tlichen Haschinen, Strasssnraarkierungsf ahrzau- 
gen, Tunnslreinigungsmaschinen, usui. Wis eruiahnt, lassen 
sich nach dem offenbarten Prinzip auch ohne Untarbrachung be- 
uiegte Fahrzeuge richtungssteuern, falls entlang der Fahrbahn 
an vorgagebenen Positionen Tripelspiegel angeordnst u/erden, * 
mie es zur Kennzeichnung der Begrenzung von Strassen bsrsits 
ublich ist- Die Messeinrichtungen an dem Fahrzeug erfassen 
dabei stufenuieise jeuieils ein Paar von Ref lektoreinrichtun- 
gen^ Nach Usberschreiten eines vorgegebenen Winkels suchen 
sich die Messeinrichtungen selbsttatig ein neues Paar von 
Reflektoreinrichtungen* 
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Patentanspruche 



1. Verfahren zur Ermittlung der Bemegungskoordinaten fur 
den richtungsgesteuerten Arbeitsablauf eines ortsbemag- 
lichen Korpers, gekennzeichnet durch Anordnen von je 
einer Reflektoreinrichtung an ziuei fixierten Stellen (B, 
C, U, T, A, B) ausserhalb des Beu/egungsbereiches des 
ortsbeu/eglichen Korpers, beruhrungs.loses elektronisches 
Messen des Abstandes (AB,- AC, LT) und/oder tnindestens 
eines Winkels (ci^,^ ,5^^,'^ .'? J zuischen einer Bezugs- 
achse des ortsbemeglichen Korpers und einer Verbindungs- 
linie zu/ischsn einer Stelle des Korpers und einer der 
Reflektoreinrichtungen mittels einer oder zuiei in Ab- 
stand voneinander auf der Bezugsachse des ortsbeuiegli- 
chen Korpers angebrachten elektronischen Messeinrichtun- 
gen und Berechnen der Koordinatenu;erte fur die jeiueilige 
Beuiegungsposition des ortsbeujeglichen Korpers aufgrund 
der geometrischen Dreiecksbeziehuncsn der Dreiecke, deren 
Eckpunkte die fixierten Stellen (B, C, U, T, A, B) und 
die Positionsstellen (A, M, L) der Hesseinrichtungen 
sind und aufgrund der gemessenen Werte dieser Dreiecke. 
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2. Uerfahren nach Anspruch 1, gekennzeichne t durch Messen 
mittsls mindestens von zujei auf dem ortsbeu/eglichen 
Korper angeordneten und um eine usrtikale Achse schiuenk 
baren Messeinrichtungen, die senkrecht zu ihren verti- 
kalen Achsen einsn bestimmten Abstand (a) voneinander 
aufweisen, uiobei die Msssung siner Entfernung (f) zu/i- 
schen einer Messeinrichtung (L) und einar Ref laktorein- 
Tichtung (T) erfolgt und die Messung von je einem Win- 
kel (cL ,R ), die sich zuiischen einer beide Messein- 
richtungen verbindenden Bezugsachse des ortsbeujeglichen 
Korpers und der Uerbindungslinien (LT, MV) zuiischen je 
einer der zuiei Messeinrichtungen (M, L) und einer der 
Ref lektoreinrich.tungen (V, T) befinden (Fig. 3, 4). 

3, Verfahren nach An'spruch 2, gekennzeichnet durch Messen 
von drei Winkeln t'm^ mittels mindestens von 
zu/ei auf dem ortsbeujeglichen Korper in horizontalem Ab- 
stand voneinander angeordneten Winkelmesseinrichtungen 
(C, E), die sich ziuischen einer beide Messeinrichtungen 
(C, E) verbindenden Bezugsachse des ortsbeu/eglichen Kor 
pers und den Uerbindungslinien (CA, CB, EA) zuischen 
einer Messeinrichtung (C) und den beiden Ref lektorein- 
richtungen (A, O) und der anderen Messeinrichtung (E) 
und einer Ref iektoreinrichtung (A) befinden (Fig* 5, 6) 



wo 82/01420 PCT/CH8 1/001 15 

- 17 - 

4. Verfahran nach Anspruch 1, dadurch gekennzeichnet , dass 
als Reflektoreinrichtung Tripelspieggl vermendet u/erden, 



5. Verfahren nach Anspruch 1 oder 2, dadurch gskennzeich- 
nat, dass jede Reflektoreinrichtung aus eineni Pfosten 
besteht, der auf sainera Umfang eine Reflexfolia tragt. 

6. Verfahran nach Anspruch 1, dadurch gekennzeichnet, dass 
die Messeinrichtung ein Zielsuchgerat (4, 26) aufu/eist, 
durch das das Messgerat uni sine Vertikalachse das orts- 
beweglichenKorpers geschmenkt wird, bis es in Richtung 
auf eine Reflektoreinrichtung ausgerichtet ist (Fig. 1, 
2 und 8). 



7. Verfahran nach Anspruch 1, dadurch gekennzeichnet, dass 
das Messen der Entfernungen (AB und AC, f) Jnittels fra- 
quenz- oder intensitatsraodulierten elsktrischan Wellen 
erfolgt. 



8. Uerfahrsn nach Anspruch 1, dadurch gekennzeichnet, da: 
die Dlstanz- und Winkelmassung durch danselben Sender 
und dieselbe Erapf angsainrichtung 24 vorganoramen tuird. 
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9. 



Uerfahren nach Anspruch 8, dadurch gekennzeichnet , dass 



die Divergenzbreite des Messtrahles in einer Entfernung 
von 50 m von dem elekt ronischen Distanzmesser 2 - 6 m 
betragt. ..... 

10. Uerfahren nach Anspruch 1 oder einem der AnsprOche 6 
•bis 9, dadurch gekennzeichnet, dass das Messen der Ent- 

fernungen uiahrend des Stillstandes des ortsbeu/eglichen 
Korpers ausgefuhrt luird, und die Kurssteuerung der Be- 
luegung zwischen den Stillstandspositionen mittels eines 
Kurskreisels erfolgt* - . 

11. Anlage zur Durchfuhrung des Verfahrens nach Anspruch 1, 
gekennzeichnet durch mindestens ein auf einem ortsbe- 
u/eglichen Kbrper (6) urn eine Vertikalachse (8) schiuenk- 
bar angebrachtes elektronisches Distanz- und/oder Win- 
kelmessgerat (2, 48) mit mindestens einem Messtrahl 
(14, 46), mindestens zu/ei Ref lektoreinrichtungen (10, 
54) mit Mitteln zur Befestigung an vorgegebenen, in be- 
zug auf einen f eststehenden Korper fixierten Stellen 
sou/ie ein elektronisches Rechengerat (32) zur Umrech- 
nung von durch das Distanz- und/oder Winkelmessgerat 
ermittelten Distanzen und/oder Winkel zu den Reflektor- 
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einrichtungen in K oordinatenujert e dss ort sbetueglichen 
Korpers in bezug auf ein Koordinatensystem. 



IZ.Anlage nach Anspruch 11, gekennzeichnet durch ein Win- 
ks Imessgerat und einen Distanzmessgerat oder durch sine 
Kombination von Beiden,mit einem Drehantrieb (A0),8inem 
Winkelkodierer (50) und eine aus einem Sender (42) und 
einem Empfanger (4A) fur eine gerichtete elektrische 
Strahlung (46) bestehende Einheit (48), die durch den 
Drehantrieb langsam um eine gemeinsame vertikale 
Achse drehbar sind,u»obei der gemessene Winkelu/ert der 
Drehposition entspricht , bei der der Empfanger (44) auf- 
grund der Reflexion uon einer der Ref lekt oreinrichtungen 
eine Strahlung maximaler -Intensitat aufnimmt. 



13.Anlage nach Anspruch 11 oder 12,dadurch gekennzeich- 
net,dass die Ref lekt oreinrichtungen aus je einem 
Pfosten (54) bestehen.der auf mindestens einem Teil 
seiner Umf angsf lache eine Reflexfolie tragt. 



wo 82/01420 



PCT/CH8 1/001 15 



2/5 




wo 82/01420 



PCT/CH8 1/001 15 



3/5 

^vj- = iSV' wenn < 



-\ I niOfP _ f niOip J 
yi^ = 2 arcosX 2 i °l 

\ n ' p 
= 36SI'- iS^ - ivenn > 

^ ^ w - y w ^^^^ 
V= (-^ -sin Bi>j)mnn ^h/ - 



dekannt sind, 


TV' 


r 






n 


Gemessen M'rd, 


LT = 


0 









Fig. A 



V ' idR°'Qrc sin {f'ffn ^tv) 
^ ' r-cos ni/^ i-p -.cos £ // • 

Xi^f' sin ' 0 

y^f= COS aiv 0 



= arc tan ^^^4 t„)-y^, 



ivenn bp^ > SSl" 



Berechnet h/ird 

im A n, o,p : p, y/t/ 

im A p.r.q ■ sfv, vh^ 

Output Q^, Xi^^, /A// 



yh/4 



h/enn Xh^^ - ^^/v^ > ^ 
und aw > f^^" 

wenn X(vf -^^2 
und ah/ > tdB" 

wenn Xiy^ - > ^ 
und < 18r 

wenn Xwi -^Xpvz ^ ^ 
und < 18^'' 
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a 



C = 



ore • cos [-cos(^^-y)J 



r, MOJ 

0 TlrFa 



b = Q-COfV-f-C'COSa 

s/n'^lii sin A^) 

I =: COS [-COS (Ab ^As)] 
= Sin (l-^o) c 



dekannf sind:Q,A,B,o 
Bern esse n M'rd : 



Bercciincf h/ird : 

im A Q.b,C: a, c,b 
im A AB,c,d I 
im A ^k/,yfv,^-^tv,ytv 

Output Qh/, JClVy/M/ 



Q 



fan a) 



Fig. 6 




wo 82/01420 



PCT/CH81/00115 



5/5 
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